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The problem of position and attitude control of the Stewart platform based docking 
mechanism is considered motivated by its future application in space missions requiring the 
autonomous docking capability. The control design is initiated based on the framework of 
the intelligent flight control architecture being developed at NASA Ames Research Center. 
In this paper, the baseline position and attitude control system is designed using dynamic 
inversion with proportional-integral augmentation. The inverse dynamics uses a Newton- 
Euler formulation that includes the platform dynamics, the dynamics of the individual legs 
along with viscous friction in the joints. Simulation results are presented using forward 
dynamics simulated by a commercial physics engine that builds the system as individual 
elements with appropriate joints and uses constrained numerical integration. 
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Nomenclature 


Angular acceleration of the leg in inertial coordinates 
Platform linear acceleration 

Linear acceleration of the lower portion of the leg in inertial coordinates 

Linear acceleration of the upper portion o'f the leg in inertial coordinates 

Platform angular acceleration in inertial coordinates 

Coefficient of viscous friction at the universal joint 

Coefficient of viscous friction at the prismatic joint 

External force acting on the platform in the platform body axes. 

Viscous friction at the joint between the platform and the I th leg 
Gravitational acceleration 

Platform moment of inertia in the inertial coordinates 

Moment of inertia of the lower portion of the leg in inertial coordinates 

Moment of inertia of the upper portion of the leg in inertial coordinates 

Length of the i* leg 

Rate of change of the length of the leg. 

Platform mass 

External moment acting on the platform in inertial coordinates 
Mass of the lower portion of the leg. 

Mass of the upper portion of the leg. 

Position vector of each of the Platform-leg joint in the Inertial coordinates 
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Platform Rotation Matrix 

Position of the CG of the lower portion of the leg in inertial coordinates 
Position of the CG of the upper portion of the leg in inertial coordinates 
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S[ — s 6 = Unit vector along each of the leg expressed in the Inertial coordinate 

W = Angular velocity of the leg in inertial coordinates 

co = Platform angular velocity in inertial coordinates 

Xj ~xi = Unknown joint forces at each of the six joints along the direction of the legs 


I. Introduction 

A utonomous rendezvous and docking has been identified as a strategic technical challenge for all future space 
missions'. An androgynous docking mechanism is being developed by the Johnson Space Center towards 
meeting that goal, which can be used across different space platforms. Figure 1 illustrates such a docking 
mechanism. The docking mechanism will be attached to the chaser spacecraft, which on close proximity will extend 
the mechanism to dock itself to the target spacecraft. Using force sensors, the two spacecrafts can then lock in to 
complete the docking maneuver. Precise position and attitude control of the docking mechanism is, therefore, a 
critical need to achieve such an autonomous docking capability. 



We propose to design the control system for the docking mechanism based on the intelligent flight control 
architecture being developed at the NASA Ames Research Center (ARC). The intelligent flight control (IFC) 
research program began in ARC in 1992 to address adaptive aircraft flight control to provide a real-time system 
capable of compensating for a broad spectrum of model uncertainties and failures 2-4 . The core of the IFC 
architecture is a neural control architecture developed by Rysdyk and Calise 5 . The control system consists of a 
dynamic inversion based controller with proportional-integral (PI) and neural network augmentation. NASA ARC 
has implemented and demonstrated this IFC architecture via several different vehicle simulations varying from small 
unmanned aircraft to large transport aircraft and highly maneuverable fighter aircraft. 



Figure 2: 6 UPS Stewart Platform 
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In this paper, the baseline control system without neural network augmentation is designed for the docking 
mechanism. The docking mechanism is modeled as a Stewart platform with six legs connecting the fixed base with 
the moving platform. Figure 2 illustrates the Stewart platform. The Stewart platform, as its name suggests, was first 
designed by Stewart for motion flight simulators 6 ''. The mechanical device, given its better stiffness and precise 
pointing capabilities, was suggested as a parallel manipulator in the robotic community and soon enough gained 
wide popularity 8 " 9 . The control design for the commercially available motion flight simulators as well as the robotic 
manipulators is, however, typically given by kinematical control laws using hand tuned PID controllers that try to 
achieve the necessary leg velocities to produce the desired platform motion. The control design outlined in this 
paper consists of a control law that considers the coupled dynamics of the platform and the individual legs. The 
control problem corresponds to computing the forces to be input at the leg prismatic joint to produce the necessary 
platform states. Adequate sensing is assumed that provides the target position and orientation, along with platform 
position, orientation and its linear and angular velocities. Similarly the lengths and the rate of change of the lengths 
of each of the six legs are assumed to be sensed. 

II. Docking Mechanism Control Architecture 
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Figure 3: Proposed docking mechanism control architecture 

Figure 3 outlines the proposed docking mechanism control architecture. The guidance law is typically designed as 
an optimal outer-loop trajectory or using waypoints that satisfy the relevant system and mission constraints. For the 
purpose of the current implementation, it is assumed that the guidance law provides the target position and 
orientation for the platform. These values are provided to the platform reference model that computes the reference 
trajectory for the platform. The reference model is divided into two parts that individually address the translational 
and rotational motions separately. The reference translational motion of the center of gravity (CG) of the platform is 
given using a second order reference model on the commanded position. 
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This translational reference model provides the reference position, velocity and acceleration of the platform CG. 
The desired acceleration of the platform CG is given using a proportional-integral augmentation as 


= a ref + K p ( v ref - v) + K , (r ref - r) 


(4) 


so that the platform CG position follows a stable second order dynamics towards the reference position. 
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The reference angular motion of the platform is given as a second order motion around the eigen axis between 
the initial and commanded quaternion. In relation to the initial platform orientation, the commanded quaternion, q c , 
is given as 



Inverting Eq. (8) provides the eigen axis, e=[ei e 2 e 3 J and the commanded angle, <p c . The reference angular 
motion is given as 


CO = 


s 2 +2£w n s + w‘ n 


-<PM 


The quaternion for the reference orientation can now be given as 


( 9 ) 
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Similarly the reference angular velocity and acceleration for the platform can be given as 


=< 


( 11 ) 


The desired angular acceleration of the platform, similar to the translational case, is given using a PI 
augmentation as 


«des = «ref - K r‘ ( “ platform ~ “ref ) + K 1X ( 12 ) 

If the system angular acceleration equals this desired angular acceleration, it has been shown that this PI 
augmentation represents a stable angular motion 10 , q' represents the vector portion of the quaternion error given by 
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The desired translational and angular accelerations given by Eqs. (4) and (12) respectively are input to the inverse 
dynamics of the system to compute the leg actuation forces. 


The inverse dynamics of the platform is based on the Newton-Euler formulation given by Dasgupta and 
Mruthyunjaya 11 . This formulation incorporates the dynamics of the platform and the dynamics of each of the legs. 
Viscous friction is assumed at each of the joints. The inverse dynamics is set up such that the linear and angular 
accelerations of the platform are given in terms of six unknown forces, one at each of the joint platform-leg joint and 
along the direction of the leg. Knowing these linear and angular acceleration values, these six unknown forces can 
be computed. They are then used in each of the six leg dynamic equations to compute the leg actuator force that is 
needed to be given at the prismatic joint for supporting these joint forces. 


The six unknown joint forces along the direction of the legs are given by 
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( 16 ) 


f = C,(W-o>) (17) 

Having found these forces, the individual leg actuator forces are given by 

F i =[ m ,« s '( a « -g) + C p L ]. ~x i (18) 

The description of the various variables is given in the Nomenclature section. The detailed analysis of the 
kinematics and dynamics of the platform and the legs can be obtained by referring to Dasgupta and Mruthyunjaya 11 . 
The dynamic inversion controller can now be designed by specifying the desired values of the translational and 
angular accelerations (a des and a des ) and substituting them in place of a and a in Eq. (14) and computing the 
individual leg actuator forces. 


III. Simulation Results 

The control system outlined in the previous section is coded in Simulink® and provides the actuating forces at 
the leg prismatic joints to the forward dynamics of the system. The forward dynamics is simulated using a physics 
engine that builds the docking mechanism as multiple bodies with the appropriate joints connecting them. The 
physics engine is coded in C/C++ and accepts inputs from the Simulink® controller through a shared memory 
interface. The physics engine also renders the output of the simulation as a real time graphic. 

The simulation results are presented for a test case consisting of commanded rotation without any commanded 
translation. 
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The commanded quaternion corresponds to Euler angles (yaw, pitch, roll) of 30 deg., -30 deg. and 0 respectively. 
Figure 4 illustrates the graphic output of the docking mechanism for the first 105 seconds of the simulation. 
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t = 0 s t = 15 s t = 30s t = 45s 



t = 60 s t = 75 s t = 90 s t = 105 s 

Figure 4: Platform attitude change graphical output for the first 105 seconds of simulation 


Figure 5 presents the comparison of the platform quaternion with the reference quaternion. Figure 6 compares 
the platform and reference angular velocities. Figure 7 presents the actuator force inputs at each of the six prismatic 
leg joints and figure 8 presents the evolution of the lengths of each of the six legs with time. It can be inferred that 
the control system is successful in following the specified reference trajectories towards achieving the commanded 
attitude. 
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Figure 5: Platform reference and actual quaternion trajectories 
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Figure 8: Time evolution of the lengths of the six legs 


IV. Conclusion 

A dynamic inversion based control system with proportional-integral augmentation has been designed and 
simulated for the space docking mechanism. The control system fits within the intelligent flight control (IFC) 
architecture that has been designed and implemented for several aircraft platforms at the Ames Research Center. The 
current control design for the docking mechanism represents the baseline control system in the IFC architecture. 
This baseline control system, as in the IFC framework, can be adapted using neural network augmentation. The 
neural network will provide additional translational and angular acceleration commands to account for modeling 
errors or faults in the system. The adaptive control implementation is currently being designed. The proposed 
control architecture, while designed with the space docking motivation, can also be applied to general purpose 
Stewart platforms in flight simulator and robotic applications. 
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